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(57) In lane keeping assistance system and method 
for an automotive vehicle, a control current (lout) to be 
outputted to a motor during an automatic steering mode 
is detected, a filter is provided for the detected control 
current to pass only signal components of the detected 
control current whose frequencies are lower than a pre- 
determined cut-off frequency value (fstr, fstrjow, 
fstr_mid, fstr_hi) to derive a filtered control current 
(loutjpf), a determination of whether a manual steering 
intervention to the automatic steering occurs is made 
according to a magnitude of the filtered control current, 
and the control current outputted to the motor is reduced 
toward zero when the manual steering intervention is 
determined to occur according to a result of determina- 
tion that the magnitude of the filtered control current 
(loutjpf) is in excess of a predetermined threshold cur- 
rent value (ioutJpf_th). 
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Description 

[0001] The present invention relates generally to lane 
keeping assistance system (also called a lane following 
vehicle control system, but, hereinafter, referred to as 5 
lane keeping assistance system) and method for an au- 
tomotive vehicle. The present invention relates more 
particularly to a technical field of the lane keeping as- 
sistance system and method in which . automatic steer- 
ing is carried out in such a way that traffic lane informa- 10 
tion is retrieved during a vehicular run and a steering 
torque is given to a steering force transmission system 
to follow the vehicle along a traffic lane at a forward di- 
rection of the vehicle or a driver's steering operation is 
supported to follow the traffic lane at the vehicular for- is 
ward direction by providing a steering reaction torque is 
given to a vehicular steering force transmission system. 
[0002] In general, the lane keeping assistance system 
has a region in which the vehicle can autonomously run 
along a white line and in which a development force by 20 
an actuator does not give an influence on a steering in- 
tervention. Hence, it is necessary to reduce the devel- 
opment force by a control quickly if a driver's steering 
intervention occurs. 

[0003] On the other hand, in a system in which a gear 25 
direct drive power steering is used, a torque sensor 
mounted on a column shift of a steering wheel can di- 
rectly be used to determine the driver's steering inter- 
vention. 

[0004] Japanese Patent Application Publication No. 30 
Heisei 9-240502 published on September 16 , 1997 ex- 
emplifies a previously proposed lane keeping assist- 
ance system. 

[0005] In the above-described Japanese Patent Ap- 
plication ^Publication, a torque sensor is installed to de- 35 
tect a steering torque from a vehicular driver in order to 
switch between automatic steering and manual steering 
by an accurate trap of an intention of the vehicular driver. 
When an output of the torque sensor is below a prede- 
termined threshold value, a control mode is shifted into 40 
an automatic steering mode. When an output of the 
torque sensor is equal to or above the predetermined 
threshold value, the control mode is shifted into the man- 
ual steering mode. 

[0006] However, automotive industry has demanded 45 
the following requirements for the lane keeping assist- 
ance system. 

[0007] That is to say, (1) Since a system cost be- 
comes high with a correction for a drift of an output value 
of the torque sensor taken into consideration, the sys- so 
tern cost is required to be reduced, and (2) Since it is 
necessary to make a part of a steering shift to which a 
steering torque is transmitted smaller in diameter (tor- 
sion bar), torsional rigidity of a steering system is re- 
duced and steering feeling thereof becomes worsened. 55 
Hence, the vehicular steering system is required to 
maintain its torsional rigidity and steering feeling there- 
of. 



[0008] Therefore, it is, according to the requirements, 
difficult to mount the torque sensor in the steering sys- 
tem in terms of the steering performance and in terms 
of the cost. Then, in a case where such a direct driver's 
steering intervention detecting device as described 
above is not present, a steering angle sensor (having a 
steering angular velocity output value) is used for a 
steering intervention determination. 
[0009] However, it is possible for the steering angle 
sensor to detect the driver's steering intervention only if 
a certain steering angular velocity occurs. Since the de- 
termination of the steering intervention in which no 
steering angular velocity is developed cannot be carried 
out, the determination of the steering intervention can- 
not be made in a case where a steady-state steering 
intervention (steering angular velocity %0° s' 1 (zero de- 
gree per second)) is carried out. 
[0010] Since the steering operations by the vehicular 
driver and by the steering control are interfered against 
each other, a large driver's undesired feeling of the 
steering operation (a dull steering and a sticky feeling) 
occurs. 

[0011] It is noted that the steady-state steering inter- 
vention (steering intervention without no generation of 
the steering angular velocity) is one of the following cas- 
es. 

[0012] © A case wherein the driver is running on or 
near to a boundary of the traffic lane (such lane mark- 
ings as left and right white lines). For example, in a case 
wherein a large-sized truck is running on an adjacent 
traffic lane, the vehicle tends to run along a line deviated 
toward another traffic lane opposite to the adjacent traf- 
fic lane on which the truck is running. A case wherein 
the vehicle is running on the traffic lane near to which a 
cobble is present aside the traffic lane with a deviation 
thereof toward the traffic lane side opposite to the cob- 
ble. 

[0013] (g) A case wherein the vehicle is not running 
along the white lines but actually is running at a different 
side-road of the white lines . For example, a case where- 
in, during a vehicular run on a freeway, a guide-way or 
taxiway such as a guidance from a traffic lane in the free- 
way to a service area is brought over. In addition, the 
steering undesired feeling due to the steering interfer- 
ence is that, in a case of the manual steering interven- 
tion, a controlled output is caused to flow in a direction 
opposite to that caused by the driver's intervention and 
undesired feelings of steering wheel' s weight increase 
and of a sticky feeling can be given to the driver 
[0014] It is. hence, an object of the present invention 
to provide lane keeping assistance system and method 
which can accurately determine such a steady-state 
steering intervention without generation of the steering 
intervention as described above and which can elimi- 
nate a large undesired feeling of steering due to a steer- 
ing interference. 

[001 5] According to one aspect of the present inven- 
tion, there is provided a lane keeping assistance system 
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for an automotive vehicle, comprising: a traffic lane in- 
formation detector (16) to detect an information related 
to a traffic lane on which the vehicle is about to run; a 
steering angle sensor (1 3) to detect a steering angle (G) 
of a steering wheel of the vehicle; a steering position 
changing section (8, 9) by which the steering wheel of 
the vehicle is enabled to be displaced independently of 
a manual steering operation through the steering wheel; 
a controlled steering target value setting section (15, 
Fig. 12) that sets a controlled steering target value (6*) 
when a controlled steering to follow the traffic lane is 
carried out on the basis of at least the traffic lane related 
information detected by the traffic lane information de- 
tector and the steering angle detected by the steering 
angle sensor; a controlled steering command value set- 
ting section (1 5, Fig. 20) that outputs a control command 
value (lout) in accordance with the controlled steering 
target value; a control command value filtering section 
(15, 22 of Fig. 2, and 62 through 66 of Fig.6) to filter the 
control command value to pass only frequency compo- 
nents of the control command value lower than a pre- 
determined filter threshold value (fstr, fstrjow, fstr_mid, 
fstr_hi) to derive a filtered control command value 
(lout_lpf_th) during an execution of the controlled steer- 
ing; a manual steering intervention detector (15, 23 of 
Fig. 2, 67 and 69 of Fig. 6) to detect a steering interven- 
tion state to the controlled steering by the manual steer- 
ing operation when the filtered control command value 
is in excess of a predetermined threshold control com- 
mand value (loutJpMh); and a controlled steering tar- 
get value limiter (1 5, 24 and 25 of Fig. 2, and 70 and 71 
of Fig. 6) to reduce the control command value (lout) 
toward zero value to suppress the controlled steering 
target value toward a lower value direction including ze- 
ro when ce manual steering intervention is detected by 
the manual steering intervention detector. 
[0016] According to another aspect of the present in- 
vention, there is provided a method applicable to a lane 
keeping assistance system for an automotive vehicle in 
which a control current is outputted to a motor (8) of an 
automatic steering actuator coupled to a vehicular steer- 
ing system (3, 7) to provide a steering force thereto to 
follow the vehicle along a traffic lane on a road located 
in a vehicularforwarding direction during a vehicular run 
in an automatic steering mode, the method comprising: 
detecting (20 of Fig. 2 and 60 of Fig. 9) the control cur- 
rent (lout) to be outputted to the motor during the auto- 
matic steering mode; providing (22 of Fig. 2, 62 through 
66 of Fig. 6) a filter for the detected control current to 
pass only signal components of the detected control cur- 
rent whose frequencies are lower than a predetermined 
threshold frequency value of the filter to derive a filtered 
control current; determining (23 of Fig. 2 and 67 and 69 
of Fig. 9) whether a manual steering intervention to the 
automatic steering occurs according to a magnitude of 
the filtered control current, the manual steering interven- 
tion being determined to occur depending on whether 
the magnitude of the filtered control current is in excess 



of a predetermined threshold current value of the filter; 
and reducing (24 and 25 of Fig. 2 and 70 and 71 of Fig. 
6) the control current outputted to the motor toward zero 
value when, at the manual steering intervention deter- 

s mining step, the manual steering intervention is deter- 
mined to occur according to a result of determination 
that the magnitude of the filtered control current 
(loutjpf) is in excess of the predetermined threshold 
current value (loutJpf_th). 

10 [0017] This summary of the invention does not nec- 
essarily describe ail necessary features so that the in- 
vention may also be a sub-combination of these de- 
scribed features. 

15 BRIEF DESCRIPTION OF THE DRAWINGS: 

[0018] Fig. 1A is a whole system configuration view 
of a vehicular steering system to which a lane keeping 
assistance system for an automotive vehicle in a first 
20 preferred embodiment according to the present inven- 
tion is applicable. 

[001 9] Fig. 1 B is a rough configuration of an automatic 
steering controller of the lane keeping assistance sys- 
tem in the first embodiment shown in Fig. 1 . 

25 [0020] Fig. 2 is an operational flowchart executed by 
the automatic steering controller shown in Figs. 1 A and 
1 B for a steering intervention determination procedure. 
[0021] Fig. 3 is a characteristic graph representing 
control current distributions during the execution of the 

30 Jane keep control and during a driver's steering interven- 
tion. 

[0022] Fig. 4 is a characteristic graph representing a 
gain characteristic of a low-pass filter (LPF) used to de- 
tect a control current for the driver's steering interven- 
es tion. 

[0023] Fig. 5 is a characteristic graph representing a 
steering intervention determination region in a low-pass 
filter output current-versus-frequency relationship. 
[0024] Fig. 6 is an operational flowchart executed in 
40 automatic steering controller and representing a flow of 
a steering intervention determination procedure in a 
second preferred embodiment according to the present 
invention. 

[0025] Fig. 7 is a characteristic graph representing a 
45 control current-versus-frequency at a low velocity re- 
gion, a middle velocity region, and a high velocity region. 
[0026] Fig. 8 is a characteristic graph representing a 
cut-off frequency characteristic of the low-pass filter with 
respect to a vehicular velocity. 
so [0027] Fig. 9 is a characteristic graph representing the 
cut-off frequency characteristic of the low-pass filter 
used to detect a driver's steering intervention. 
[0028] Fig. 10 is an explanatory view representing a 
vehicular position with respect to a traffic lane during an 
55 input of an external disturbance to the vehicle. 

[0029] Fig. 11 is an explanatory view representing the 
vehicular position with respect to the traffic lane during 
the input of the driver's steering intervention. 
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[0030] Fig. 1 2 is an operational flowchart representing 
an example of a main control routine on a lane keep con- 
trol executed in the automatic steering controller. 

DETAILED DESCRIPTION OF THE PREFERRED 
EMBODIMENTS: 

[0031] Reference will hereinafter be made to the 
drawings in order to facilitate a better understanding of 
the present invention. 

First Embodiment 

[0032] Fig. 1 A shows a whole system configuration of 
a steering system of an automotive vehicle to which a 
lane keeping assistance system in a first preferred em- 
bodiment according to the present invention is applica- 
ble. 

[0033] In Fig. 1 A, a column shaft 2 is inserted into an 
inside of a steering column 1 and is supported by the 
steering column 1 . A steering wheel 3 is disposed on an 
upper end of column shaft 2. A rack-and-pinion steering 
mechanism 6 is linked to steer left and right road wheels 
4 and 5 at a lower end of column shaft 2. An assistance 
actuator 7 (or.so-called, automatic steering actuator) to 
provide an auxiliary steering torque is disposed at an 
intermediate position of column shaft 2. 
[0034] Assistance actuator 7 includes: an electric mo- 
tor 8; an electromagnetic clutch 9 disposed on a motor 
axle; a drive gear 1 0 rotationally driven by motor 8 via 
electromagnetic clutch 9; and a worm-gear-to-speed-re- 
duction mechanism having a driven gear 12 meshed 
with drive gear 1 0. 

[0035] A steering angle sensor 1 3 to detect a rotation- 
al angle of column shaft 2 is disposed on a position of 
column shaft 2 placed in proximity to steering wheel 3. 
An angle sensor 1 4 to detect a rotational angle of driven 
gear 10 is disposed. Sensor output signals from steering 
angle sensor 1 3 and angle sensor 1 4 are inputted to an 
automatic steering controller 15. 

[0036] Automatic steering controller 1 5 receives a vid- 
eo signal from a CCD (Charge Coupled Device) camera 
1 6 arranged to photograph a forward road zone in a ve- 
hicular forwarding direction and a vehicular velocity in- 
dicative signal from a vehicular velocity sensor 17 as 
well as the sensor output signals from the steering angle 
sensor 13 and angle sensor 14. 

[0037] In addition, automatic steering controller 15 
outputs a control current via a motor drive circuit 1 5g to 
motor 8 and outputs a clutch or de-clutch command to 
electromagnetic clutch 9. 

[0038] Furthermore, an automatic steering controller 
15 implements image processing of road images in the 
vehicular forwarding direction on the basis of the video 
signal from CCD camera 1 1 , extracts and discriminates 
boundary lines of a forward traffic lane such as a white 
line (broken line form) or center (boundary) line (solid 
line form), and generates vehicular running state infor- 



mation of a host vehicle (host vehicle means the vehicle 
on which the lane keeping assistance system is mount- 
ed). 

[0039] In addition, when an automatic steering mode 
5 is selected, both of a steering torque and a target steer- 
ing angle needed to follow the host vehicle along the 
forward traffic lane are calculated. To make the actual 
steering angle substantially equal to the target steering 
angle, automatic steering controller 1 5 implements fun- 
10 damental control of lane keeping assistance by output- 
ting the control current to motor 8. 
[0040] Fig. 1 B shows a basic interna! structure of au- 
tomatic steering controller 15. 

[0041] Automatic steering controller 15 includes: a 
15 CPU (Central Processing Unit, but also called Micro- 
processor unit) 15a; a V-RAM (Video Random Access 
Memory) 15b; a RAM (Random Access Memory) 15c; 
a ROM (Read Only Memory) 1 5d, an Input Port 15e, an 
Output Port 15f, motor drive circuit (PWM (Pulse Width 
20 Modulation) circuit) 15g, and a common bus. 

[0042] Next, an operation of the above-described lane 
keeping assistance system in the first preferred embod- 
iment will be described. 

25 Steering intervention determination procedure 

[0043] Fig. 2 is an operational flowchart representing 
a flow of a steering intervention procedure executed by 
automatic steering controller 15. Each step shown in 
30 Fig. 2 will be described below. 

[0044] At a step 20, controller 15 detects the control 
current outputted to motor 8 from controller 15 (via the 
motor drive circuit 15g). 

[0045] At the next step 21 , controller 1 5 retrieves the 
35 vehicular velocity from vehicular velocity sensor 1 7. 
[0046] At the next step 22, controller 15 provides a 
low-pass filtering process to pass signal components of 
only a low frequency range for the detected control cur- 
rent at step 20 to calculate a filtered output current 
40 loutjpf. 

[0047] It is noted that although a cut-off frequency of 
the low-pass filter is a predetermined constant value, 
another low-pass filter having a cut-off frequency varia- 
ble characteristic such that as the vehicular velocity be- 
45 comes higher the cut-off frequency is shifted toward a 
higher direction may be used since the vehicular velocity 
is retrieved at step 21 . 

[0048] At a step 23, controller 21 determines whether 
the calculated filtered output current lout_lpf is in excess 

50 of a steering intervention threshold current lout_lpf_Jh. 
[0049] If No at step 23 (loutjpf ^ lout_lpf_th), con- 
troller 15 does not determine the steering intervention 
but returns to step 20. If Yes at step 23 (loutjpf > 
loutjpf Jh), controller 15 determines that the steering 

>5 intervention is present and the routine goes to a step 24. 
[0050] At step 24, controller 1 5 gradually reduces the 
output current to 0 [A]. It is noted that, basically, when 
the steering intervention is determined to be present, the 
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steering control may be turned to off. However, since an 
abrupt (stepwise) change of a steering force results in 
a steering unmatched feeling to a vehicular driver, the 
output current is gradually reduced. 
[0051] At the next step 25, controller 15 determines 
whether a time duration from a time at which the answer 
of Yes is determined at step 23 is elapsed by a set time 
duration t [seconds]. Until the set time duration t is 
passed, the reduction process of the control current at 
step 24 is continued. It is noted that a return condition 
cannot be determined from the output current since the 
output current is already reduced and a time manage- 
ment is used to determine an automatic return. 

Steering intervention determination action 

[0052] When the vehicle is running during an auto- 
matic steering mode, the control current to make the 
host vehicle follow the traffic lane of the vehicular for- 
warding road is outputtedto motor 8 so that the vehicular 
run to follow the traffic lane without the driver's steering 
operation can be assured. 

[0053] During the vehicular run in the automatic steer- 
ing mode, controller 15 provides at step 22 in Fig. 2 the 
low-pass filtering process for the control current output- 
ted to the motor 8 to calculate the filtered output current 
loutjpf. At step 23, if the filtered output current loutjpf 
is in excess of steering intervention output current 
threshold current loutJpMh, controller 15 determines 
that the driver has intervened in the automatic steering 
and the routine goes to step 24. At step 24, the control 
current for motor 8 of assistance actuator 7 is gradually 
reduced. 

[0054] That is to say, as viewed from a control current 
distribution during the steering intervention in Fig. 3, the 
control current distribution by a lane keep control indi- 
cates a high density in a proximity to a vehicular yaw 
resonance of 1 Hz but that by a steady-state steering 
intervention indicates a distribution at a frequency re- 
gion lower than that in the case of the lane keep control 
since a steering velocity is extremely low in the steady- 
state steering intervention. It is noted that since the 
steering velocity occurs during the steering intervention 
at the proximity to the frequency of the lane keep control, 
it is possible to make the driver's intervention determi- 
nation according to the steering velocity (steering angu- 
lar velocity). 

[0055] Furthermore, during the steering intervention, 
since a large control current against the driver's inter- 
vention is outputted from controller 15, the output control 
current is constantly held at a output current limier llmt 
(ike an adhesive so that the control current distribution 
is concentrated in a control current limit value region as 
denoted by oblique lines in Fig. 3. 
[0056] Then , the low-pass filter (ref erto Fig. 4) is used 
which has a cut-off frequency fstr of a boundaryfrequen- 
cy of two control current distributions. When the low- 
pass filter (shown in Fig. 4) processing is carried out for 



the control current to motor 8, a frequency characteristic 
only according to the control current (= filtered output 
current loutjpf) caused by the steering intervention at 
the low frequency region as appreciated from Fig. 5. 
5 [0057] Furthermore, if a region such that the filtered 
output current loutjpf exceeds the steering intervention 
threshold current lutjpf_th is prescribed, this region of 
steering intervention determination corresponds to the 
control current limit value region denoted by the oblique 
10 lines in Fig. 3. In other words, if the filtered output current 
loutjpf is in excess of the steering intervention thresh- 
old current loutjpf, controller 15 can determine that the 
driver performs the steady-state steering intervention. 
[0058] Next, an advantage in the first embodiment will 
15 be described below. 

[0059] In the first embodiment, the control current is 
used to determine the driver's steering intervention and, 
during the driver's steering intervention determination, 
control mode is gradually transferred to a manual steer- 
20 ing mode by the vehicular driver. Hence, although the 
driver's steering intervention determination is based on 
the determination without use of the torque sensor to 
directly detect the driver's steering intervention or with- 
out use of the steering angle sensor to indirectly detect 
25 the driver's steering intervention, the steady state steer- 
ing intervention which does not generate the steering 
angular velocity can accurately be determined and such 
a large difference in the unmatched feeling of steering 
due to a steering interference between the lane keep 
30 control and the manual steering intervention by the driv- 
er can be eliminated. 

[0060] It is noted that in a case where the cut-off fre- 
quency of the low-pass filter (LPF) is varied according 
to the vehicular velocity, a more accurate determination 
35 of the steady-state steering intervention can be carried 
out as will be described later. 

Second Embodiment 

40 [0061] The whole configuration of the lane keeping 
assistance control is the same as that in the first embod- 
iment shown in Figs. 1A and 1B, Hence, the detailed 
explanation of the system configuration will herein be 
omitted. 

45 [0062] Fig. 6 shows an operational flowchart repre- 
senting a flow of the steering intervention determination 
procedure executed by automatic steering controller 1 5 
in the second preferred embodiment. 
[0063] At a step 60 in Fig. 6, automatic steering con- 

50 troller 1 5 detects the control current outputted to motor 
8. 

[0064] At a step 61 , controller 1 5 retrieves the vehic- 
ular velocity. 

[0065] At a step 62, controller 1 5 selects one of low- 
55 pass filters having difference cut-off frequencies accord- 
ing to a magnitude of the vehicular velocity retrieved at 
step 61 . The magnitude of the vehicular velocity is di- 
vided into three regions, i.e., a low vehicular velocity re- 
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gion, a middle vehicular velocity region, and a high ve- 
hicular velocity region. 

[0066] At a step 63, controller 15 executes the low- 
pass filtering procedure using the low vehicular velocity 
region low pass filter having the cut-off frequency 5 
fstrjow for the detected control current at step 60. 
[0067] At a step 64, controller 15 executes the low- 
pass filtering procedure using the middle vehicular ve- 
locity region low-pass filter having the cut-off frequency 
frst_mid for the detected control current at step 60. 10 
[0068] While, at a step 65, controller 15 executes the 
low-pass filtering procedure using the high vehicular ve- 
locity region low-pass filter having the cut-off frequency 
frstjii for the detected control current at step 60. 
[0069] At a step 66, the filtered control current lout Jpf 15 
is calculated from the low-pass filtered control current 
passed at any one of steps 63, 64, and 65. 
[0070] At a step 67, controller 1 5 determines If the fil- 
tered output current loutjpf calculated at step 66 is in 
excess of the steering intervention threshold current 20 
loutJpMh. If No (loutjpf g lout_lpf_th) at step 67, con- 
troller 15 determine that there is no steering intervention 
and the routine returns to step 60. If Yes at step 67, the 
routine goes to a step 68. 

[0071 ] At step 68 , controller 1 5 retrieves a camera im- 25 
age and detects a lateral deviation Ym of a vehicular 
running position from a center position of the host vehi- 
cle running traffic lane. 

[0072] At step 69, controller 15 determines if an ab- 
solute value I Yml of the lateral deviation detected at step 30 
68 is in excess of an external disturbance determination 
deviation threshold Ym_th. If No (lYml ^ Ym_th) at step 
69, controller 15 determines that there is no steering in- 
tervention and the routine returns to step 60. If Yes at 
step 68, the routine goes to a step 70. 35 
[0073] At step 70, controller 1 5 reduces gradually the 
output current toward zero 0 [A]. It is noted that basically 
the control may be turned off during the steering inter- 
vention. However, the abrupt change results in the un- 
matched steering feeling and, therefore, the output cur- 40 
rent is gradually reduced. 

[0074] At the next step 71 , controller 1 5 determines if 
the time duration from the time at which the controller 
1 5 determines Yes at step 69 has passed by the set time 
t [sec.]. Until the set time t, the reduction process of the 45 
output current at step 70 is continued. It is noted that 
the return condition is not determined from the output 
current since the output current is already reduced but 
is the automatic return according to the time manage- 
ment. 50 

Vehicular velocity dependent change in cut-off 
frequency 



[0075] An action to differ the cut-off frequency of the 
low-pass filter according to the vehicular velocity will be 
explained below. 

[0076] During the vehicular run in the automatic steer- 
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ing mode, controller 1 5 at step 62 selects one of the low- 
pass filters having mutually different cut-off frequencies 
according to the magnitude of the vehicular velocity (low 
vehicular velocity region, the middle vehicular velocity 
region, and the high vehicular velocity region). In other 
words, at the low vehicular velocity region, the low ve- 
hicular velocity region low-pass filter having the cut-off 
frequency fstrjow. At the middle vehicular velocity re- 
gion, the middle vehicular velocity region low-pass filter 
having the cut-off frequency fstr_mid is selected. At the 
high vehicular velocity region, the high vehicular velocity 
region low-pass filter having the cut-off frequency frst__hi 
is selected. Then, the low-pass filtering process is car- 
ried out for the detected control current at any one of 
steps 63, 64, and 65 and at step 66 the filtered output 
current loutjpf is calculated. 

[0077] In details, as shown in Fig. 7, in the lane keep 
control, a control response to follow the traffic lane is 
increased as a rise in the vehicular velocity so that the 
control current distribution during the lane keep control 
is shifted toward the higher frequency side. In the same 
way, the control current distribution due to the driver's 
steering intervention is also shifted toward the higher 
frequency side as the vehicular velocity is increased. In 
other words, suppose that the boundary frequency of 
the two control current distribution during the driver's 
steering intervention and the lane keep control is the cut- 
off frequency. As shown in Fig. 7, the boundary frequen- 
cy is varied in such a way as the cut-off frequency 
fstrjow at the low vehicular velocity region, thatfstr_mid 
at the middle vehicular velocity region, and that fstr_hi 
at the high vehicular velocity region. 
[0078] For a switching method of the cut-off frequency 
according to the vehicular velocity, it is desirable to vary 
continuously the cut-off frequency according to the ve- 
hicularvelocity as shown in Fig. 8. However, in terms of 
processing capacity, such a method that several low- 
pas filters having the different cut-off frequencies are 
prepared and these filters are switched is general. For 
example, in the case of the second embodiment, three 
cut-off frequencies are switched as shown in Fig. 9. 
[0079] Hence, since the cut-off frequency fstr of the 
low-pass filter is varied according to the vehicular veloc- 
ity, the more accurate determination of the steady-state 
steering intervention can be made. 

Steering intervention determination action 

[0080] During the vehicular run in the automatic steer- 
ing mode, if the filtered output current loutjpf is in ex- 
cess of the steering intervention threshold current 
loutjpf _th at step 67 and the detected lateral deviation 
absolute value lYml is in excess of the set external dis- 
turbance determination threshold Ym_th, controller 15 
determines that the driver (driver 1 steering operation) 
has intervened the automatic steering and the routine 
shown in Fig. 6 goes to step 70 at which controller 15 
reduces gradually the control current for motor 8 of the 



6 



11 



EP 1 184 254 A2 



12 



assistance actuator. 

[0081 ] That is to say, as shown in Fig. 1 0, the control 
current is supplied to motor 8 so that the host vehicle 
runs on a center part of the traffic lane which indicates 
a target traffic lane in the lane keep control against the 
input of an external disturbance such as road surface 
cant, lateral wind, or so forth. On the other hand, as 
shown in Fig. 1 1 , the control current is supplied to motor 
8 so that the host vehicle is maintained to run on the 
traffic lane that the vehicular driver intends in the same 
manner as the case of the external disturbance, during 
the steering input by the driver. Since this control current 
is adhered or held on the limit value due to the provision 
of the limiter in the output current, the determination of 
whether it is the external disturbance input time or the 
driver* s steering input time cannot be made only by the 
control current value. 

[0082] However, during the external disturbance in- 
put, the host vehicle, basically, runs on the center posi- 
tion of the traffic lane which is the target traffic iane (refer 
to Fig. 10). While, during the driver's steering input, the 
host vehicle runs on a position of the traffic lane which 
is deviated from the center position of the traffic lane 
toward one of the left and right white lines (lane markers) 
in order to avoid collision against a large-sized truck 
which is running on one of the adjacent traffic lanes or 
the adjacent lane (refer to Fig. 11). 
[0083] Therefore, it becomes possible to distinguish 
the driver's steering input from the external disturbance 
input by determining the driver's steering intervention 
using a logical AND condition between the control cur- 
rent condition and the host vehicle position deviation 
condition. Hence, a more accurate determination for the 
steady-state steering intervention can be achieved. 
[0084] It is noted that if a control current exceeding a 
control limitation is caused to flow into motor 8 during 
the occurrence in the external disturbance, the host ve- 
hicle runs deviating toward one of the left and right white 
lines. However, in this state, control is disabled and it is 
desirable to turn the control output to OFF in the same 
way as the case of the driver's steering intervention. 

Other Embodiments 

[0085] Although, in the lane keeping assistance sys- 
tem in each of the first and second preferred embodi- 
ment, the low-pass filter (LPF) is used to pass there- 
through only the signal components in the low frequency 
range to the control current, a band pass filter (BPF) 
which passes the signal components of a middle fre- 
quency range between the low frequency range lower 
than the lower cut-off frequency and the high frequency 
range higher than the upper cut-off frequency may be 
used. 

[0086] Although : in the lane keeping assistance sys- 
tem in each of the first and second embodiments, the 
present invention is applicable to the controller from 
which the steering torque is provided for the steering 



system during the automatic steering mode, the present 
invention is also applicable to a controller from which a 
steering reaction force torque is provided thereto. In the 
latter case, such a control that as a magnitude of the 
5 intervention from the driver becomes larger, the steering 
reaction torque becomes smaller is carried out. 

Lane keep assistance main routine 

io [0087] Fig - 12 shows an operational flowchart repre- 
senting an example of the lane keep control procedure 
executed by automatic steering controller 15 in each 
embodiment during the automatic steering mode. 
[0088] Fig. 12 is a main interrupt routine executed 

15 whenever a predetermined period of time, for example, 
10 milliseconds has passed. 

[0089] At a step S1 , controller 1 5 reads actual steer- 
ing angle 8 detected by steering angle sensor 13, a ve- 
hicular velocity detection value V detected by vehicular 

20 velocity sensor 1 7, a yaw angle <£, lateral deviation y, 
and a radius of curvature p of the extracted white line 
. detected from CCD camera 1 6 and image processed by 
controller 15. Then, the routine goes to a step S2. 
[0090] At step S2, controller 15 calculates a target 

25 steering angle G* using the following equation (1 ) on the 
basis of the yaw angle <E>, the vehicular lateral deviation 
, y, and the radius of curvature p. 



30 2 



0* = Ka • O + Kb • y + Kc • p 



(1). 



[0091] In the equation (1 ), Ka, Kb, and Kc denote pre- 
: - set control gains varied according to the vehicular ve- 
locity and target steering angle G* indicates a positive 

35 value when the steering direction is in a clockwise di- 
rection as viewed from the driver's position and a neg- 
ative value when the steering direction is in a counter- 
clockwise direction as viewed from the driver's position. 
[0092] Next, at a step S3, automatic steering control- 

40 ler 1 5 calculates the motor supply current lout using the 
following equation (2) and performs PID (Proportional- 
• Integration-Differential) control to make the actual steer- 
ing angle 6 substantially equal to target steering angle 
8*. Then, the motor supply current, i.e., the output cur- 

^5 : rent from controller 15 to motor 8 is stored into a motor 
supply current memory location to update the corre- 
sponding contents of the motor supply current memory 
location. 



50 



lout = Kvi(Kp + Ki/s + kd ■ s) ( 9* - 9) 



(2). 



[0093] In the equation (2), Kvi denotes a control gain 
to convert a voltage value into a current value, Kp de- 
55 * notes a proportional gain, Ki denotes an integration 
4 gain, and Kd denotes a differential gain. 
[0094] It is noted that a reason for controller 15 to cal- 
culate the motor supply current lout using the above- 
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described equation (2) is that controller 1 5 subtracts ac- 
tual steering angle e to derive a deviation A e from both 
steering angle values, performs the PID calculation for 
the deviation A 9 to derive a target motor control voltage 
V*, and converts target motor control voltage V* into the 5 
corresponding current value by a multiplication of the 
target motor control voltage V* by control gain Kvi to cal- 
culate the motor supply current lout to motor 8, and the 
series of these calculations are carried out in a feedback 
loop configuration of controller 15 itself, motor 8, and 10 
associated sensors 13, 14, 16, and 17, and, in this feed- 
back loop configuration, controller 1 5 performs its equiv- 
alent calculations. 

[0095] At the next step S4, automatic steering control- 
ler 15 determines whether the calculated motor supply 15 
current lout is in excess of the current limit value I limit 
stored in a current limit value memory location. If lout ^ 
I limit at step S4, the routine goes to a step S6. If lout > 
I limit at step S4, the routine goes to a step S5. 
[0096] At step S5, automatic steering controller 1 5 as- 20 
signs the current limit value llimit (Mimit -> lout) and 
stores this motor supply current lout( i.e., llimit) into the 
motor supply current memory location to update the cor- 
responding contents and the routine goes to step S6. 
[0097] At step S6, controller 15 outputs the motorsup- 25 
ply current (control current) lout stored in the motor sup- 
ply current memory location which is pulse-width mod- 
ulated in PWM (Pulse-Width Modulator) circuit 15g to 
motor 8 whose direction is in accordance with the 
present steering direction. 30 
[0098] Traffic lane information detecting means cor- 
responds to CCD camera 16 and automatic steering 
controller 15. Steering angle detecting means corre- 
sponds to steering angle sensor 13 and is exemplified 
by United States Patent No. 6,155,106 issued on De- 35 
cember 5, 2000. The CCD camera is exemplified by 
United States Patent No. 6,226,592 issued on May 1, 
2001 . A controlled steering target value corresponds to 
target steering angle 6* described above. A control com- 
mand value corresponds to the control current lout (this 40 
corresponds to the motor supply current). It is also noted 
that angle sensor 14 shown in Fig. 1 A is used to detect 
the rotational angle of drive gear 10 to confirm the 
present steered position of the vehicle, electromagnetic 
clutch 9 is in the clutched state in response to the clutch 45 
command from automatic steering controller 15 during 
the automatic steering mode, and the automatic steer- 
ing corresponds to a controlled steering. 
[0099] The entire contents of Japanese Patent Appli- 
cation No. 2000-268218 (filed in Japan on September so 
5, 2000) are herein incorporated by reference. Although 
the invention has been described above by reference to 
certain embodiment of the invention, the invention is not 
limited to the embodiments described above. Modifica- 
tions and variations of the embodiments described 55 
above will occur to those skilled in the art in the light of 
the above teachings. The scope of the invention is de- 
fined with reference to the following claims. 



. A lane keeping assistance system for an automo- 
tive vehicle, comprising: 

a traffic lane information detector (1 6) to detect 
information related to a traffic lane on which the 
vehicle is about to run; 

a steering angle sensor ( 1 3) to detect a steering 
angle (6) of a steering wheel of the vehicle; 
a steering position changing section (8, 9) by 
which the steering wheel of the vehicle is ena- 
bled to be displaced independently of a manual 
steering operation through the steering wheel; 
a controlled steering target value setting sec- 
tion (15, Fig. 12) that sets a controlled steering 
target value (0*) when controlled steering to fol- 
low the traffic lane is carried out on the basis of 
at least the traffic lane related information de- 
tected by the traffic lane information detector 
and the steering angle detected by the steering 
angle sensor; 

a controlled steering command value setting 
section (15, Fig. 20) that outputs a control com- 
mand value (lout) in accordance with the con- 
trolled steering target value; 
a control command value filtering section (15, 
22 of Fig. 2, and 62 through 66 of Fig. 6) that 
filters the control command value to pass only 
frequency components of the control command 
value lower than a predetermined filter thresh- 
old value (fstr, fstrjow, fstr_mid, and fstr_hi) to 
derive a filtered control command value 
(loutJpMh) during execution of the controlled 
steering; 

a manual steering intervention detector (15, 23 
of Fig. 2, 67 and 69 of Fig. 6) to detect a steering 
intervention state to the controlled steering by 
the manual steering operation when the filtered 
control command value is in excess of a prede- 
termined threshold control command value 
(loutJpMh); and 

a controlled steering target value limiter (1 5, 24 
and 25 of Fig. 2, and 70 and 72 of Fig. 6) to 
reduce the control command value (lout) to- 
ward zero value to suppress the controlled 
steering target value toward a lower value di- 
rection including zero when the manual steer- 
ing intervention is detected by the manual 
steering intervention detector. 

2. A lane keeping assistance system for an automo- 
tive vehicle as claimed in claim 1 , further compris- 
ing: 

a vehicular velocity detector (1 7) to detect a ve- 
hicular velocity (V) of the vehicle; and 
a predetermined threshold value varying sec- 
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4. 



5. 



tion (15, Fig. 7) that varies the predetermined 
filter threshold value (fstr) when the control 
command value filtering section provides the fil- 
ter for the control command value to pass only 
predetermined frequency components lower 5 
than the predetermined filter threshold value; 

wherein the predetermined threshold value 
varying section varies the predetermined threshold 
value of the filter thereof toward a higher frequency 10 
side (Fig. 8) as the detected vehicular velocity (V) 
becomes increased. 

A lane keeping assistance system for an automo- 
tive vehicle as claimed in claim 1 or claim 2, further 15 
comprising a lateral displacement detector (15) to 
detect lateral displacement (Ym) of the vehicle from 
a center position of the traffic lane on the basis of 
the traffic lane information from the traffic lane in- 
formation detector (16), wherein the manual steer- 20 
ing intervention detector (15) detects the steering 
intervention state by the manual steering operation 7. 
when the filtered control command value is in ex- 
cess of the predetermined threshold control com- 
mand value and, in addition, a magnitude (lYmi) of 25 
the detected lateral displacement is in excess of an 
external disturbance determination threshold value 
(Ym_th). 

A lane keeping assistance system for an automo- 30 
tive vehicle as claimed in claim 1 , wherein the steer- 8. 
ing position changing section comprises an electric 
motor (8) and the control command value is a cur- 
rent (lout) to be supplied to the electric motor. 

35 

A lane keeping assistance system for an automo- 
tive vehicle as claimed in claim 1 , wherein the filter 
of the control command value filtering section com- 
prises a low-pass filter and the predetermined filter 
threshold value is a cut-off frequency (fstr, fstrjow, 40 
fstrjnid, and fstrjii) of the low-pass filter. 

A method applicable to a lane keeping assistance 
system for an automotive vehicle in which a control 
current is outputted to a motor (8) of an automatic 45 
steering actuator coupled to a vehicular steering 9. 
system (3, 7) to provide a steering force thereto to 
follow the vehicle along a traffic lane on a road lo- 
cated in a vehicular forwarding direction during a 
vehicular run in an automatic steering mode : the so 
method comprising: 

detecting (20 of Fig. 2 and 60 of Fig. 9) the con- 
trol current to be outputted to the motor during 
the automatic steering mode; 55 
providing (22 of Fig. 2, 62 through 66 of Fig. 6) 
a filter for the detected control current to pass 
only signal components of the detected control 



current whose frequencies are lower than a 
predetermined th reshold frequency value of the 
filter to derive a filtered control current; 
determining (23 of Fig. 2, 67 and 69 of Fig. 6) 
whether a manual steering intervention to the 
automatic steering occurs according to a mag- 
nitude of the filtered control current, the manual 
steering intervention being determined to occur 
depending on whether the magnitude of the fil- 
tered control current is in excess of a predeter- 
mined threshold current value of the filter; and 
reducing (24 and 25 of Fig. 2, 70 and 71 of Fig. 
6) the control current outputted to the motor to- 
ward zero value when, at the manual steering 
intervention determining step, the manual 
steering intervention is determined to occur ac- 
cording to a result of determination that the 
magnitude of the filtered control current 
(loutjpf) is in excess of the predetermined 
threshold current value (lout_lpf__th). 

A method applicable to a lane keeping assistance 
system for an automotive vehicle as claimed in 
claim 6, further comprising detecting (61 of Fig. 6) 
a vehicular velocity, wherein the predetermined 
threshold frequency value (fstr) is a cut-off frequen- 
cy of the filter, the cut-off frequency being varied to- 
ward a higherfrequency side as the detected vehic- 
ular velocity becomes higher (Fig. 7). 

A method applicable to a lane keeping assistance 
system for an automotive vehicle as claimed in 
claim 6, further comprising: detecting (61 of Fig. 6) 
a vehicular velocity (V), wherein the filter comprises 
a low vehicular velocity low-pass filter having a low- 
est cut-off frequency (fstrjow), a middle vehicular 
velocity low-pass filter having a second lowest cut- 
off frequency (fstr_mid), and a high vehicular veloc- 
ity low-pass filter having a highest vehicular velocity 
cut-off frequency (fstr_hi), and wherein, at the filter 
providing step (62 through 66 of Fig. 6), one of the 
low-pass filters is selected according to a magni- 
tude of the detected vehicular velocity and the fil- 
tered control current (loutjpf) is calculated. 

A method applicable to a lane keeping assistance 
system for an automotive vehicle as claimed in any 
one of the preceding claims 6 through 8, further 
comprising detecting (68 of Fig. 6) traffic lane relat- 
ed information and detecting a lateral deviation of 
a vehicular position from a center position of the 
traffic lane on the basis of the detected traffic lane 
related information, wherein, at the manual steering 
intervention determining step (67 and 69 of Fig. 6), 
the manual steering intervention is determined to 
occur when the filtered control current is in excess 
of the predetermined threshold current value and, 
in addition, when a magnitude (I Yml) of the detected 
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lateral deviation is in excess of an external distur- 
bance determination threshold value (YrrMh). 

10. A method applicable to a lane keeping assistance 
system for an automotive vehicle as claimed in any s 
one of the preceding claims 6 through 9, wherein, 
at the control current reducing step (24 and 25 of 
Fig. 2, 70 and 71 of Fig. 6), the control current (lout) 
is gradually reduced toward zero value. 
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